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SONAR SCANNER 

Cross-Ref erence To Related Applications 
This application claims priority from U.S. Provisional 
Application No. 60/222,542, filed on August 3, 2000, the 
contents of which are hereby incorporated by reference into 
this application as if set forth herein in full. U.S. 
Patent Application No. 09/826,209, filed April 4, 2001, and 
U.S. Provisional Application No. 60/194,922, filed April 4, 
2000 are also incorporated by reference into this 
application as if set forth herein in full. 

Technical Field 
This invention relates generally to using sound waves 
to detect objects and, more particularly, to a sonar 
scanner that uses sound waves to detect objects in the 
environment of a mobile robot. 

Background 

A mobile robot senses objects in its environment in 
order to determine its own location, map the environment 
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for later localization and navigation, and, in non-static 
environments, to avoid obstacles. 

A number of obstacle detection systems are currently 
in use, including complex computer vision systems, scanning 
5 laser range finders, and arrays of discrete ultrasonic 
transducers. Computer vision and scanning laser range 
finders tend to be prohibitively expensive in many 
applications. Mobile robots therefore often use ultrasonic 
sonar devices for obstacle avoidance. 

10 The word "sonar" is an acronym for "SOund Navigation 

and Ranging". A sonar scanner typically includes a 
transmitter, a transducer, a receiver, and a signal 
processor. An electrical impulse (or "pulse"), usually a 
waveform, from the transmitter is converted into a sound 

is wave by the transducer and propagated in a given direction. 
When the sound wave strikes an object, it rebounds, 
producing an "echo". This echo strikes the transducer. 
The transducer converts the echo into an electrical signal, 
which is amplified by the receiver and fed into a detector 

20 and stored for processing. 

Since the speed of sound in any given environment is 
known, the time lapse between the transmitted signal and 
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the received echo can be measured and the distance to an 
object that produced the echo determined. This time lapse 
is called the "time of flight". 

One configuration for producing the transmitted signal 
5 and receiving the echo is a sonar ring. A sonar ring 

includes a number of transducers positioned around a robot 
to allow simultaneous sensing in more than one direction. 
A sonar ring may include any number of transducers and may 
or may not provide detection in a 360° field, depending on 
10 the number, placement and echo field of the transducers. 

For example, where each transducer's echo field covers 15° 
of radial space, a robot would need 24 evenly-spaced and 
directed transducers in order to have full 360° coverage. 
This high number of sonar components has a number of 
15 drawbacks, including cost. Not only do sonar ring systems 
eliminate many of the cost benefits of using a sonar-based 
system, sonar rings often produce data of questionable 
quality due to the increased amount of acoustic energy 
being transmitted into the environment from multiple 
20 transducers. This acoustic energy may reflect off of 
multiple objects, resulting in multipath reflections. 
Multipath reflections are echoes that have not traveled in 
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a direct path from the object to the receiver. For 
example, an echo that reflects off of one or more walls 
will have a longer time of flight and appear as an object 
farther away from the sonar scanner than it is in fact. 
5 Thus, the transducer is subject to receiving sound 

waves from several sources, not just the intended echo. 
Distinguishing between the echo, spurious signals and/or 
extraneous noise is one challenge faced in designing a 
sonar scanner for a mobile robot or other application. In 

10 addition to multipath reflections, examples of extraneous 
environmental noise include acoustic steady state and 
periodic noise, acoustic impulse noise, electrical impulse, 
and ultrasonic noise from intentional sources, such as 
other robots, ultrasonic door openers, etc. 

15 In a sonar scanner, the transducer emits a signal (or 

pulse) having a finite duration, temit- Conventionally, 
during the process of emitting the pulse, the receiver is 
disabled by a system controller as it waits for the 
transducer to cease operation in order to begin listening 

20 for the echo. The time that the receiver is disabled is 
known as the "blanking time" t b iank. The receiver is 
disabled in order to be sure that it does not become 
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saturated as it detects the transducer emitting the sound 
wave. A byproduct of this delay, i.e., the receiver 
blanking time, is that it prevents the sonar scanner from 
detecting real objects within a certain distance. 

Typically, the duration of the pulse signal is reduced 
in order to reduce the minimum measurable distance of the 
sonar scanner. Due to its mechanical nature, however, the 
transducer continues to vibrate even after the transmitter 
signal has ceased. This continued vibration is typically 
referred to as the "ring-down". This additional latency in 
the system extends t e mit, so that the total time of the 
signal can be characterized as the duration of the pulse 
(tpuise) plus the duration of the ring-down (t r ing-down) - 
Thus, the ring-down makes it difficult for a sonar scanner 
to detect objects within a certain distance. In the prior 
art, the minimum detection distance is about one foot. 

In addition, mobile robot sonar scanners also face 
challenges from extraneous noise in the environment. For 
example, if the environment contains a continuous source of 
acoustic or electrical noise, such as a vacuum cleaner or 
air conditioning unit, the sonar scanner may be susceptible 
to this noise. The robot itself may be a source of 
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continuous noise, which could also affect the ability of 
the sonar scanner to detect echoes. 

Summary 

5 In general, in one aspect, the invention is directed 

to a system for transmitting a sound wave comprised of a 
first portion and a second portion, obtaining a 
characteristic of the second portion, storing the 
characteristic, and using the characteristic to detect an 

10 echo of another sound wave. This aspect of the invention 
may include one or more of the following features. 

The first portion may be a pulse signal and the second 
portion may be a ring-down signal. The ring-down signal 
may be a signal that decays in amplitude over time. The 

is ring-down signal may be a function of a transducer that 

transmits the pulse signal. The characteristic may include 
an amplitude in the ring-down signal. 

The system may include transmitting the other sound 
wave comprised of a first portion and a second portion, 

20 receiving an echo of the other sound wave, and analyzing 
the echo of the other sound wave based on the 
characteristic. Analyzing the echo may include 
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distinguishing the second portion of the other sound wave 
from the echo of the other sound wave. Distinguishing the 
second portion may include detecting an amplitude in the 
echo based on the characteristic. Detecting the amplitude 
5 in the echo may include assigning a threshold based on the 
characteristic and comparing the amplitude in the echo to 
the threshold. The amplitude in the echo is detected if 
the amplitude in the echo exceeds the threshold. 

In general, in another aspect, the invention is 

10 directed to a system for measuring ambient noise at 

transmission of a first signal comprised of a pulse and a 
decaying portion, obtaining an amplitude in the decaying 
portion, removing the ambient noise from the amplitude, and 
using the amplitude with removed ambient noise to 

15 distinguish a decaying portion of a second signal from an 
echo of the second signal. This aspect of the invention 
may include one or more of the following features. 

Using the amplitude to distinguish the decaying 
portion may include measuring ambient noise at transmission 

20 of the second signal, combining the ambient noise and the 
amplitude, and comparing the decaying portion of the second 
signal with the combined ambient noise and the amplitude. 
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The decaying portion may include a ring-down signal that 
results from a transducer transmitting the pulse. The 
ambient noise may be electrical and/or acoustic noise. The 
system may include transmitting the second signal and 
5 receiving the echo of the second signal. 

In general, in another aspect, the invention is 
directed to a system for distinguishing an echo of a 
transmitted signal from impulse noise. The system includes 
'fi receiving a signal having an amplitude, measuring a 

!H 10 duration of the amplitude, and determining if the duration 
^ exceeds a period. If the duration exceeds the period, the 

ffl signal is the echo of the transmitted signal and, if the 

s duration does not exceed the period, the signal is the 

|fl impulse noise. This aspect may include one or more of the 

HI 15 following features. 

The period may be a fraction (e.g., 1/10) of a period 
of the transmitted signal. The impulse noise may be 
electrical noise and/or acoustic noise. If the signal is 
impulse noise, it may be ignored. 
20 In general, in another aspect, the invention is 

directed to a system for transmitting a signal towards two 
objects, a first of the objects being in front of a second 
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of the objects, receiving a first echo from the two 
objects, and receiving a second echo from the two objects. 
If the second echo is comprised of an amplitude having a 
greater amplitude than the first echo, the system uses the 
5 first echo to determine information relating to the first 
object and uses the second echo to determine information 
relating to the second object. This aspect of the 
invention may include one or more of the following. 

The information relating to the first object includes 

10 a distance to the first object. The information relating 
to the second object includes a distance to the second 
object. Data that corresponds to the first echo and/or the 
second echo is stored. The first object may be 
acoustically-weaker than the second object. 

15 In general, in another aspect, the invention is 

directed to a system for transmitting a waveform having a 
predetermined shape, receiving a signal, analyzing a shape 
of the signal, and determining if the signal comprises an 
echo of the waveform based on the analysis of the shape of 

20 the signal. This aspect of the invention may include one 
or more of the following features. 
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If the signal has substantially the predetermined 
shape, the signal is determined to be an echo of the 
waveform. If the signal deviates beyond a certain 
tolerance from the predetermined shape, the signal is 
determined not to be an echo of the waveform. 

In general, in another aspect, the invention is 
directed to a pulse-echo sonar scanner for a mobile robot. 
The sonar scanner includes a transmitter which generates a 
pulse signal, an acoustic transducer which transmits and 
receives acoustic signals, a receiver, means for 
determining performance characteristics of the transducer 
for a given pulse, means for storing the performance 
characteristics, and means for determining threshold levels 
for an echo signal based on the stored performance 
characteristics. This aspect of the invention may include 
one or more of the following features. 

The acoustic transducer is capable of rotation through 
360°. A controller may be used to control an angular 
position of the acoustic transducer. The scanner may 
include a reflective surface on the acoustic transducer 
that is controlled by the controller. 
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In general, in another aspect, the invention is 
directed to a pulse-echo sonar scanner for a mobile robot. 
The sonar scanner includes a transmitter which generates a 
pulse signal, a single acoustic transducer which transmits 
5 and receives acoustic signals, a receiver, means for 

determining a level of ambient noise in an environment, and 
means for adjusting a threshold level of the receiver such 
that the threshold level is at least as high as the level 
of ambient noise. 
10 In general, in another aspect, the invention is 

directed to a method of adjusting threshold levels on a 
mobile robot scanner. The method includes measuring ring- 
down characteristics of the mobile robot scanner, creating 
a dynamic threshold level based on the ring-down 
is characteristics, and applying the dynamic threshold levels 
to received signals. 

In general, in another aspect, the invention is 
directed to a method of adjusting threshold levels on a 
mobile robot scanner to compensate for effects of ambient 
20 noise. The method includes measuring the ambient noise and 
adjusting the threshold levels such that the threshold 
levels are at least as high as a level of the ambient 
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noise . 

Other features and advantages of the invention will 
become apparent from the following description, including 
the claims and drawings. 

Brief Description of the Drawings 

Fig. 1 is a block diagram of circuit elements that 
make up a sonar scanner. 

Fig. 2 is a perspective view of the sonar scanner. 

Fig. 3 is a graph showing a sound wave produced by the 
sonar scanner. 

Fig. 4 is a graph showing a waveform used to excite a 
transducer in the sonar scanner to produce the sound wave. 

Fig. 5 is a graph showing amplitude thresholds for the 
sound wave of Fig. 3. 

Fig. 6 is a flowchart showing a process performed by 
the sonar scanner for analyzing echoes. 

Fig. 7 is a graph of a pulse that is transmitted in 
response to detection of an echo. 

Fig. 8 is a flowchart showing a process performed by 
the sonar scanner for obtaining information from echoes 
produced by objects that are one in front of the other. 
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Fig. 9 is a perspective view of two objects that are 
positioned one in front of the other. 

Description 

Fig. 1 shows a block diagram of a sonar scanner 10 for 
a mobile robot. Sonar scanner 10 includes a transducer 12, 
a transmitter 14 for generating a sound wave, and a 
receiver 16 for receiving an echo of that sound wave. 
Transmitter 14 produces electrical signals based on the 
output of signal processor 18, which cause transducer 12 to 
vibrate and thereby output sound waves. 

Transducer 12 is also responsive to received sonar 
echoes produced from the transmitted sound waves. The 
received echoes are transmitted from transducer 12 to 
rece i ver ±Q f where they are demodulated, digitized, and 
transmitted to signal processor 18 for processing. 

To this end, receiver 16 includes a low-noise pre- 
amplifier 22 to amplify the received echo signals, a 
bandpass filter 24 to remove signals outside of the echo 
frequency range, and a logarithmic demodulated amplifier 26 
and gain block 28 to amplify and acquire the envelope of 
the filtered signals. Analog-to-digital converter (ADC) 30 
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digitizes these signals and provides them to signal 
processor 18. Comparator 32 receives the analog signals 
and compares them to predetermined thresholds, as described 
below. These thresholds may be stored, e.g., in a memory 
5 of signal processor 18 and converted to analog form via 
digital-to-analog converter (DAC) 34 prior to comparison. 
Results of the comparison are provided to signal processor 
18. Alternatively, the function of comparator 32 may be 
implemented in software running on signal processor 18. 
10 A host interface 36 is also connected to signal 

processor 18. Host interface 36 allows a host, e.g., a 
mobile robot, to receive commands from signal processor 18 
that are based on transmitted and received sound waves. 
For example, an object may be detected, as described below, 
is using sonar scanner 10. Signal processor 18 may then 
notify the host processor of the object's existence. 

Fig. 2 shows a perspective view of sonar scanner 10. 
Sonar scanner 10 includes an acoustic reflector 38 that is 
mounted on a servo motor (not shown) . The servo motor 
20 rotates acoustic reflector 38 so that acoustic reflector 38 
transmits the sound waves generated by transducer 12 at any 
angle of a 360° radial direction. The rotation is fluid, 
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but slow enough so that the echo of a sound wave can be 
received by the sonar scanner. In other embodiments, the 
sonar scanner 1 s rotation can be in discrete angular steps 
controlled by a stepper motor. The rate of rotation of the 
5 servo motor is determined by the time of flight of the 
sound wave. That is, the longer the time of flight, the 
slower the servo motor rotates and vice versa. A 
controller, such as signal processor 18, may be used to 
determine the rate of rotation. 

10 Reflector 38 may be an angled structure for 

transmitting sound waves in a desired echo field. An echo 
field, in this context, is an area for receiving echoes 
from an object. Reflector 38 is contained within a cone- 
shaped housing 40 that allows transducer 12 to "pick-up" an 

15 echo in the echo field. The size and shape of the echo 

field are based on angle 42 and the shapes of the reflector 
and transducer. 

In this embodiment, a plane-shaped acoustic mirror is 
used as the reflector. It is noted, however, that the 

20 reflector may be contoured to passively form the outgoing 
acoustic energy into a predetermined shape. This would 
also shape the transducer's receive sensitivity pattern. 



- 15 - 



Attorney Docket No. 09945/006001 

In this embodiment, the reflector is shaped so that it 
detects objects at a ±5° angle relative to a center-line of 
the reflector. By changing the shape of the reflector, and 
thus the shape of the outgoing energy, e.g., from a 
5 circular shape to an elliptical shape, it is possible for 
the reflector to pick-up objects at different angles. 

This embodiment of sonar scanner 10 uses a single 
transducer (versus the "sonar ring" of the prior art, which 
used as many as 24 transducers, plus electronics) . Using a 
io single transducer, instead of multiple transducers, reduces 
the cost of sonar scanner 10 relative to its conventional 
counterparts. A single transducer also lowers the amount 
of acoustic energy in the environment. Also, a single 
transducer results in fewer sound waves reflecting off 
is surfaces in a given area. Even in the preferred 

embodiment, the sonar scanner is subject to potential 
multipath errors. For example, the sonar scanner emits a 
sound wave facing east, the sound wave reflects off a wall, 
and the sonar scanner (still rotating), picks up the echo 
20 facing north. Such multipath errors can be reduced by 

adjusting the rotational velocity of the single transducer 
periodically to separate real objects from "ghost" objects. 
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A single transducer also limits the echo field, thereby 
reducing receipt of false or spurious signals by the 
transducer. 

The entire sonar scanner 10 may be mounted on a mobile 
platform having a drive mechanism that propels a robot. 
Any type of drive mechanism and robot may be used. 
Examples of a mobile platform that may be used are shown in 
U.S. Patent Application No. 09/826,209 and U.S. Provisional 
Application No. 60/194,922 incorporated by reference above. 

Fig. 3 shows the profile of a sound wave 44 produced 
by transducer 12. The transducer is excited with a square 
wave 43 (Fig. 4) and outputs the sinusoidal waveform of 
Fig. 3. As shown, the waveform of sound wave 44 includes a 
pulse signal/portion 46 and a "ring-down" signal/portion 
48. Ring-down signal 48 is produced by transducer 12 as 
transducer 12 settles. That is, while transducer 12 is 
excited by transmitter 14, transducer 12 produces pulse 
signal 46. When the electrical stimulus provided by 
transmitter 14 is removed from transducer 12, due to its 
mechanical nature, transducer 12 does not immediately cease 
operation. Rather, the operation of transducer 12 ceases 
gradually, resulting in the decaying waveform of ring-down 
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signal 48. The length and period of ring-down signal 48 
depends on the mechanical characteristics of transducer 12. 

Fig. 5 shows the demodulated version of the sound wave 
44. As shown, pulse signal 46 has an amplitude "A" and a 
5 time duration "t pu ise". While pulse signal 46 can have a 
variable waveform shape and frequency, sonar scanners for 
mobile robots typically use a sinusoidal waveform operating 
at an ultrasonic frequency of between 40kHz (kilohertz) and 
215kHz, e.g., 92KHz. It is noted, however, that sonar 
10 scanner 10 is not limited to use with these frequencies. 
Higher frequencies provide better resolution in general, 
but higher-frequency signals attenuate quicker, which 
reduces detection range. 

After tpuise, transducer 12 begins its ring-down, 
15 during which sound waves are produced having decreasing 
amplitudes 50, 52, 53, etc. These amplitudes are set as 
amplitude thresholds for the ring-down signal. Ring-down 
signal 48 has a duration of tringdown- Thus, the total 
duration of the sound wave produced by transducer 12 is 
20 tbiank, which equates to t pu ise plus t ringdown • 

If there is an object in the transducer's echo field, 
sound wave 44 reflects off of that object and produces an 
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echo 54 (Fig. 4) . The demodulated echo 54 is shown in Fig. 
5. The echo returns to the transducer at time t T oF, where 
"TOF" stands for "time of flight". The distance (D) from 
transducer 12 to the object then can be calculated as 
follows 

D = vtTOp/2, 

where "v" in the above equation is the velocity of sound in 
the environment that transducer 12 is operating. 

As noted above, the ring-down time can affect the 
distance that can be sensed using transducer 12 because it 
can be mistaken for an echo. A long ring-down time can 
make it difficult to detect objects that are in close 
proximity to the transducer. That is, the ring-down signal 
can interfere with transducer receipt of the echo, making 
it difficult for the transducer to distinguish between the 
echo and the ring-down signal. 

Dynamic Threshold Control 

In order to reduce the foregoing problems associated 
with detecting the echo in the presence of the ring-down 
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signal, sonar scanner 10 uses dynamic threshold control. 
Dynamic threshold control is a process that uses amplitude 
detection with time varying thresholds to distinguish the 
echo from the ring-down signal within the ring-down period. 
5 Distinguishing the echo from the ring-down signal in this 
manner makes it possible for the sonar scanner to detect 
objects that are relatively close in proximity to the 
transducer. 

Referring to Fig. 6, a dynamic threshold control 
io process 56 is shown. Blocks 601 to 608 of Fig. 6 define 
the transducer modeling process and blocks 612 to 617 
define the pulse-echo process. Process 56 includes a 
calibration phase, during which the processor determines 
the amount of ambient noise in the environment, i.e., the 
is noise floor. The calibration phase can be performed at 
initial power-up of the scanner or it can be performed at 
any time from an idle mode by sending to the processor the 
appropriate commands via the host interface. 

At calibration (601), the processor determines a zero 
20 degree reference point. The zero degree reference point is 
used by the device in determining where objects are located 
relative to the sensor. A Hall-Effect sensor (not shown), 
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which is located on a PCB electronics board mounted on the 
robot, is used to determine the zero degree reference 
point. The Hall-Effect sensor acts as an absolute 
reference point. One of ordinary skill in the art will 
recognize that other sensors, such as an optical 
interrupter or a contact switch can be used instead. 

The Hall-Effect sensor contains two elements: a 
sensor and a magnet. A motor rotates the magnet relative 
to the sensor. When the magnet crosses the sensor, a logic 
signal is generated, to indicate the zero degree reference 
point. A counter (not shown) receives the logic signal and 
begins counting to keep track of where the transducer is 
relative to the zero degree reference point. In this 
embodiment, calibration is performed twice; however, it may 
be performed any number of times. 

Following position calibration, process 56 "models" 
transducer 12. What is meant by "model" in this context is 
that process 56 determines the ring-down characteristics of 
the transducer when it is excited, such as the amplitudes 
of sound waves produced by transducer 12. Process 56 uses 
this information to distinguish echoes from transducer 
ring-down, as described in more detail below. 
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During process 56 (modeling of transducer 12) , the 
processor measures (602) the level of electrical and 
acoustic ambient noise in the robot's environment. Ambient 
environmental electrical and/or acoustic noise can affect 
the transducer's ability to detect the amplitude of an echo 
signal. For example, if amplitude thresholds are 
determined in the presence of a high level of ambient 
noise, the system may not accurately detect the amplitudes 
of echoes that are generated in environments having lower 
levels of ambient noise. In more detail, the ambient noise 
will increase the amplitudes of the echo, resulting in 
higher amplitude thresholds. Subsequent echoes measured 
in, e.g., less noisy environments may not be detected 
because their amplitudes will not reach the heightened 
thresholds. In measuring the level of ambient noise, 
process 56 takes (603) a number of samples (e.g., 64 
samples) and stores (604) the maximum value of those 
samples . 

Transmitter 14 excites transducer 12 with an impulse 
train. In response to the impulse train, transducer 12 
vibrates, emitting (605) a sound wave. The sound wave 
includes a pulse signal 46 and a ring-down signal 48 (see, 
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e.g., Fig. 3). Receiver 16 "listens" to the sound wave 
output by transducer 12. Receiver 16 receives (606) a 
sound wave, demodulates and digitizes the sound wave, and 
removes (e.g., subtracts) (607) the measured amount of 

5 ambient noise from the sound wave. Receiver 16 stores 

(608) amplitudes 55 (see Fig. 5) of the ring-down portion 
of the sound wave in an array of N (e.g., 16) memory 
elements, or "bins", within signal processor 18. 

Process 56 then waits for a predetermined period of 

10 time following transmission of the sound wave. In this 
embodiment, the predetermined period of time is 50 ms 
(milliseconds); however, the invention is not limited to 
this time period. During this time period, the transmitted 
sound wave dissipates. 

15 Process 56 repeats blocks 602 to 608 a number of 

times. In this embodiment, process 56 repeats blocks 602 to 
608 16 times, although the blocks may be repeated any 
number of times. Each time blocks 602 to 608 are repeated, 
process 56 stores the amplitudes of the ring-down signal 48 

20 (Fig. 5) . Process 56 stores the largest amplitude of the 
ring-down signal and assigns these to be the amplitude 
thresholds. Alternatively, process 56 may process the 
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amplitudes in order to assign the thresholds. For example, 
process 56 may average the amplitudes from corresponding 
cycles of different signals. 

Process 56 uses the amplitude thresholds to 
5 distinguish between the ring-down signal and the echo. 
That is, the thresholds for the ring-down signal will 
generally be lower in amplitude than the echo. Comparing 
received signals to the amplitude thresholds thus 
determines which signals are ring-down signals (or 
io extraneous noise) and which are echoes. 

In one mode of operation, the acoustic reflector of 
sonar scanner 10 spins continuously throughout a 360° field 
of view while transmitting sound waves in the environment. 
In this mode, process 56 measures (609) the noise floor at 
is the time of operation. Process 56 takes a number (e.g., 
16) of samples of the receiver electrical and acoustic 
noise floor and stores (610) the peak amplitudes of the 
noise floor in memory. 

Process 56 determines the angular velocity of the 
20 acoustic reflector assembly based on the maximum desired 
detection distance of the transducer. In this embodiment, 
the reflector does not move more than 8° in the amount of 
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time that it takes for the transmitted sound wave to travel 
out a preset maximum detection distance to an object and 
back to the transducer. The acoustic reflector rotates at 
the determined velocity, which is controlled by a digital 
5 proportional-integral controller (not shown) . 

Process 56 remodels (611) transducer 12 using data 
obtained in blocks 609 and 610 every 368°, although 
remodeling may take place at other angles. For cycles in 
which remodeling does not take place, process 56 skips from 

10 block 608 directly to block 612. Normal data collection is 
suspended during remodeling. Remodeling takes place to 
adapt to changes in the transducer ring-down profile due to 
changing environmental conditions (e.g., temperature) and 
transducer degradation (e.g., material fatigue). 

15 Process 56 uses the measurement of the ambient noise 

at the time that the transducer is remodeled to determine 
the threshold used in the above comparison. That is, 
process 56 combines (e.g., adds) the ambient noise measured 
at the time the transducer is remodeled with the stored 

20 amplitude values. This way, the amplitudes are adapted to 
the noise environment in which the echo occurs, hence the 
term "adaptive threshold". That is, the thresholds set by 
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the amplitudes are modified take into account the ambient 
noise in the current environment of the echo. 

Process 56 excites (612) transducer 12 with a waveform 
from transmitter 14 to transmit a sound wave. The 
5 fundamental frequency of the waveform and its pulse shape 
are programmable, thus making it possible to shape the 
waveform. Process 56 stores the angle of the acoustic 
reflector at the time the transducer is excited. This 
information is used to position objects relative to the 
10 robot in the environment. 

In process 56, receiver 16 receives (613) an echo of 
the transmitted sound wave. Process 56 uses (614) the 
stored amplitudes from the ring-down portion of the sound 
wave to distinguish the ring-down portion from the echo, 
is In this embodiment, process 56 collects data for three 
echoes from each transmitted sound wave, although the 
invention is not limited as such (i.e., data for more or 
less echoes may be collected, as desired) . The data stored 
for each echo includes the time of flight, the peak 
20 amplitude of the demodulated echo, the duration of the 

echo, and the angle of the acoustic reflector at the time 
that the echo is received. 
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As data for each signal is received, process 56 runs 
the data through three software filters executing in signal 
processor 18 to determine if the signals are "valid" echoes 
from an object within the field of view of the transducer 
5 or the result of electrical and/or acoustic noise, such as 
the ring-down signal. 

The filters include a dynamic threshold filter. The 
dynamic threshold filter analyzes the received signal in 
order to distinguish a valid echo of the pulse signal from 
io the ring-down signal of the original sound wave or 

extraneous noise. Process 56 detects amplitudes of the 
signal based on the thresholds stored in memory. 

In more detail, process 56 compares the amplitude of 
the received signal to a corresponding threshold from 
is memory (e.g., 55 from Fig. 5). If the amplitude of the 
received signal exceeds the threshold, then the received 
signal is determined to be the echo of the pulse signal 
(see, e.g., echo 54 of Fig. 5). The dynamic threshold 
filter compares the ring-down signal of the transmitted 
20 sound wave to the combined amplitude and ambient noise 

values. The combined amplitude and ambient noise comprise 
the echo threshold for the current environment. That is, a 
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signal at that level or above is determined to be an echo 
of the transmitted pulse signal of the sound wave. A 
signal below that level is determined to be a ring-down 
signal of the sound wave, or noise. In case an echo is 
5 detected, a pulse (Fig. 7) is transmitted to signal 

processor 18. Thus, the dynamic threshold filter is able 
to distinguish ring-down signals from echoes without regard 
to ambient noise. It is noted that the thresholds will be 
at least as high as the measured ambient noise, since the 
10 ambient noise is added to the amplitude values. 

Impulse Noise 

Process 56 also runs (616) the received signal through 
a minimum pulse width duration filter. The minimum pulse 

is width duration filter measures the width of the signal to 
determine if it has greater than a predetermined duration. 

In this regard, impulse noise, i.e., short duration, 
high amplitude noise, can adversely affect echo detection. 
The minimum pulse width duration filter therefore discounts 

20 impulse noise during echo detection. The minimum pulse 

width duration filter measures a duration of the detected 
echo and determines if the duration exceeds a predetermined 



- 28 - 



Attorney Docket No. 09945/006001 

period. The predetermined period may be obtained 
experimentally and stored in memory, or it may simply be 
assigned and stored. The predetermined period may be a 
fraction of the period of the transmitted signal. For 
5 example, it may be one-tenth of the period of the 
transmitted signal, or any other fraction thereof. 

If the duration of the signal exceeds the 
predetermined period (and exceeds the appropriate amplitude 
threshold as described above) , the minimum pulse width 

10 duration filter decides that the received signal is an echo 
of the pulse signal. If the duration of the signal does 
not exceed the predetermined period, the minimum pulse 
width duration filter decides that the signal is impulse 
noise. Impulse noise is simply ignored, whereas the echo 

15 may be used to determine information relating to an object, 
such as the distance to the object, as described above. 

Waveform Shaping 

Process 56 uses a waveform filter (617) to determine 
20 the shape of the echo. In this embodiment, the shape of 

the echo should match the shape of the transmitted pulse to 
within some preset tolerance. In process 56, transducer 12 
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transmits a sound wave that has been shaped, i.e., a 
waveform having a predetermined shape. The shape of the 
waveform is determined based on electrical signals from 
transducer 12. Changing these signals changes the shape of 
5 the waveform. 

Transducer 12 receives a signal following the 
transmission. The shape filter analyzes the signal in 
order to determine if the signal is an echo of the 
transmitted sound wave. The shape filter performs the 

io analysis by obtaining the shape of the received signal and 
comparing the shape of the received signal to the pre- 
stored shape of the transmitted sound wave. If the shapes 
are within a pre-set tolerance of one another, e.g., if 
they match by 90% or some other number, then the received 

15 signal is determined to be the echo of the transmitted 

sound wave. Otherwise, the received signal is determined 
not to be an echo. 

If the dynamic threshold control filter, the minimum 
pulse width duration filter, and the waveform filter all 

20 indicate that the received signal is an echo, process 56 
determines that the signal is an echo. In this case, the 
received signal may be used to determine the distance to an 
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object or any other information relating thereto that can 
be ascertained based on the echo. If the received signal 
is not an echo, it is merely ignored. 

It is noted that process 56 may be performed without 
using one or more of the dynamic threshold control filter, 
the minimum pulse width duration filter, and/or the 
waveform filter. Also, additional filters (not shown 
herein) may be added, as desired. 

Modes of Operation 

The velocity mode of operation, in which transducer 12 
rotates, is described above. Other modes of operation also 
may be used. In the "position" mode of operation, process 
56 rotates acoustic reflector 38 to a commanded position, 
where transducer 12 is continuously excited. For example, 
acoustic reflector 38 may be rotated to a position to focus 
on a particular object. At that position, data may be 
collected for the object. The remainder of the position 
mode is identical to that described above. 

Process 56 may also operate in a "fire" mode. In the 
fire mode, the transducer emits a single sound wave and 
collects data from up to three echoes of that sound wave in 
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the manner described above in the current position. 

Multiple Object Detection And Validation 

Process 56 may store information relating to multiple 
5 echoes from the same object, as described above. Process 
7 0 (Fig. 8), on the other hand, is used to determine 
information relating to objects that are positioned one in 
front of the other. In particular, process 70 detects 
echoes of objects in which an acoustically-weaker object is 

io in front of an acoustically-stronger object. 

In this context, an acoustically-weak object is an 
object that does not reflect sound waves well. For 
example, small and/or narrow objects, such as a lamppost, 
may not reflect sound waves as well as large flat objects, 

15 such as a wall. Likewise, the texture of an object may 
affect the object's ability to reflect sound waves. For 
example, hard, smooth objects will reflect sound waves 
better than soft or rough object. 

Process 70 detects multiple (e.g., three) echoes in 

20 cases where an acoustically-weak object is positioned in 
front of an acoustically-stronger object relative to 
transducer 12. Process 70 does this by detecting echoes 
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from the two objects that have increasing amplitudes. In 
this regard, although process 70 is described for the case 
of two objects, it may be used for any number of objects. 
Process 7 0 may also detect any number of echoes. 

5 In process 70, transducer 12 transmits (801) a sound 

wave towards the two objects, such as objects 72 and 74 
shown in Fig. 9. The sound wave may be a signal, such as 
that shown in Fig. 3. Transducer receives (802) a first 
echo from the objects and then receives (803) a second echo 

io from the objects. Process 70 detects amplitudes in the 

first and second echoes and compares (804) the amplitudes 
in corresponding cycles of the echoes. 

If the amplitudes of the second echo exceed the 
amplitudes of the first echo in corresponding cycles, this 

is means that the object that reflected the second echo is 
acoustically-stronger than the object that reflected the 
first echo. If the amplitudes of the second echo exceed 
the amplitudes of the first echo (805), process 70 
determines (806) that the second object is a valid object 

20 and not a multipath reflection (since process 70 assumes 

that a weaker signal behind a smaller signal is a multipath 
error) . The two objects may then be analyzed, as described 
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above. For example, process 70 may analyze its echoes to 
determine the distances to each of the objects from 
transducer 12. Process 70 may also store the information 
that it learns from the echoes in memory for later use. If 
5 the amplitudes of the second echo do not exceed the 

amplitudes of the first echo (805), process 70 returns to 
block 803, whereafter blocks 803 to 805 are repeated. 

Process 70 may be performed alone or in conjunction 
with process 56 described above. 

10 

Architecture 

Processes 56 and 70 are not limited to use with the 
hardware/software configuration of Figs. 1 and 2; they may 
find applicability in any computing or processing 

is environment. To the extent practicable, processes 56 and 
70 may be implemented in hardware (e.g., an ASIC 
{Application-Specific Integrated Circuit} and/or an FPGA 
{Field Programmable Gate Array}), software, or a 
combination of hardware and software. 

20 Processes 56 and 70 may be implemented using one or 

more computer programs executing on programmable computers 
that each includes a processor, a storage medium readable 
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by the processor (including volatile and non-volatile 
memory and/or storage elements), at least one input device, 
and one or more output devices. 

Each such program may be implemented in a high level 
5 procedural or object-oriented programming language to 

communicate with a computer system. Also, the programs can 
be implemented in assembly or machine language. The 
language may be a compiled or an interpreted language. 
Each computer program may be stored on a storage 
10 medium or device (e.g., CD-ROM, hard disk, or magnetic 

diskette) that is readable by a general or special purpose 
programmable computer for configuring and operating the 
computer when the storage medium or device is read by the 
computer to perform processes 56 and 70. 
15 Processes 56 and 70 may also be implemented using a 

computer-readable storage medium, configured with a 
computer program, where, upon execution, instructions in 
the computer program cause the computer to operate in 
accordance with processes 56 and 70. 
20 Processes 56 and 70 may be used together or alone. 

Processes 56 and 70 may be used in conjunction with a 
mobile robot, as described herein, or outside the context 
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of robotics. Processes 56 and 70 may be used to determine 
information other than that described above (i.e., 
distance) . For example, processes 56 and 70 may be used to 
determine the shape of an object, the texture of an object, 
5 or any other information that can be obtained based on 
acoustic echoes from an object. 

Other embodiments not described herein are also within 
the scope of the following claims. 

What is claimed is: 
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